float32[6] joint
geometry_msgs/Pose Pose
uint16 arm_err
uint16 sys_err

